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Abstract 



Q Target motion analysis with wideband passive sonar has received much attention. Maximum- 

likelihood probabilistic data-association (ML-PDA) represents an asymptotically efficient estimator for 
^ deterministic target motion, and is especially well-suited for low-observable targets; the results presented 

^^ here apply to situations with higher signal to noise ratio as well, including of course the situation of a 

(N 

■^1^ we study the inverse problem, namely, how to identify the observing platform (following a "two-leg" 

J^ motion model) from the results of the target estimation process, i.e. the estimated target state and the 

^^ Fisher information matrix, quantities we assume an eavesdropper might intercept. We tackle the problem 

and we present observability properties, with supporting simulation results. 



deterministic target observed via "clean" measurements without false alarms or missed detections. Here 
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Figure 1: The target estimation process by the platform side. 



I. Introduction 



A. Problem Motivation 



Target motion analysis (TMA) with bearings-only measurements is a well- understood and 
extensively studied problem (see Fig. 1). It has been shown in the literature that as long as the 
platform is outmaneuvering the target, observability of the latter is assured and its motion can 
be inferred, even from very noisy measurements. Conversely, it is useful to understand whether, 
given the results of TMA estimation, it could be possible to identify, completely or at least 
partially, the trajectory of the observing platform. 

More specifically, the problem arises when a "target-friendly" entity, as opposed to being 
cooperative with the platform, intercepts the results of the target estimation performed by the 
platform (see Fig. 2); the question is whether this entity can identify, partially or totally, the 
trajectory of the platform. The feasibility of this problem is of twofold interest: (z) it verifies 
the utility of intercepting communications (containing TMA-related information) between the 
platform and platform-cooperative entities, because this information would be useful; and {ii) 
it motivates, at the platform side, the need for secure and encrypted transmission of the TMA 
estimation results. 
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(a) Intercepting target estimation results from the platform side. 



(b) Identifying the platform trajectory. 



Figure 2: The platform identification process by the target-friendly side. 



B. Related Works 

Seminal results on the continuous-time observability of the target motion, through a wideband 
passive sonar, were derived in [23], [13]. In fact, by successive differentiations of the measure- 
ment function, a necessary condition was derived and it was shown that a platform maneuver is 
a needed prerequisite to ensure observability of the target; however unobservable maneuvering- 
platform trajectories could exist (i.e. the platform may still take a trajectory wherefrom the 
target is unobservable). This analysis was rigorously extended, in the form of a necessary and 
sufficient condition, in [26], [12], [4], [18]; a comprehensive analysis of observability related to 
practical scenarios was also conducted in [18]. These results were also demonstrated in discrete- 
time in [14] via linear algebra; observability insights in different scenarios were presented, and 
also a stochastic observability (and estimability) analysis was performed. In [16] a theoretical 
connection between the invertibility of the Fisher information matrix (FIM) and target (local) 
observability was established. In [25] (and references therein) the optimal platform maneuver 
was designed, in the sense of the best estimation accuracy in terms of the FIM. 

There are three common approaches to standard TMA (with or without Doppler measure- 
ments): maximum likelihood (ML), pseudolinear (PL) and instrumental variables (IV) estimation. 
Although the first approach is asymptotically efficient, it is complex and therefore suboptimal 
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solutions are desirable. PL estimation has the advantage of being in closed form and of easy 
computation; however it can lead to severe bias even in favorable conditions [9]. Consequently 
IV estimation, yielding estimates with reduced bias, has seen recent attention [15], [10], [9], 
[11], [28]. 

Alternative bearings-only TMA scenarios have been studied recently in [3], [19], [8] and 
ML batch estimators have been proposed. More specifically, in [3] the problem of bearings- 
only TMA for conditionally-deterministic target motion and with operational constraints on the 
platform is tackled with Markov chain Monte Carlo methods. In [19] TMA of a maneuvering 
target and non-maneuvering platform is studied; observability is established and a batch estimator 
is proposed. The concept was later applied to the scenario of a circular constant-speed target 
and a non-maneuvering target in [8]. 

The estimators proposed in these references do not deal with the problem of false measure- 
ments (clutter) and less-than-unity probability of detection. The seminal work in [17] derived 
a ML estimate of target parameters for both wideband and narrowband passive sonars in the 
presence of false detections (clutter), based on probabilistic data association (ML-PDA); the 
performance of the estimator was evaluated in terms of the Cramer-Rao lower bound (CRLB). 
It was shown that the effect of the clutter on the performance through the CRLB was simply 
via a product with a less-than-unity scalar value, called the information reduction factor (IRF). 

The ML-PDA was extended by incorporating amplitude information to enhance performance 
in the scenarios of "low-observable" (i.e. low Signal-to-Noise ratio) targets in [21]; improved 
accuracy and superior global convergence were demonstrated. In [7] ML-PDA was applied to 
the problem of low-observable target estimation using electro-optical sensors; also a sliding- 
window batch approach for ML-PDA estimation was derived, capable of dealing with temporary 
disappearance of targets and/or targets with velocities changing over time. ML-PDA was also 
successfully applied to active sonar tracking in [6], where also an efficient computation of the 
ML estimate, namely, directed subspace search (DSS), was derived. The use of ML-PDA for 
early track detection with a radar is discussed in [2]. 

C. Main Results and Paper Organization 

The main contributions of the present paper are summarized as follows: 
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• We study the "inverse" problem of identifying the platform trajectory, following a "two- 
leg" motion model, through its ML-PDA estimation results on a target; to the best of our 
knowledge, such a problem is addressed here for the first time. 

• We derive and study the objective function to be optimized for identifying the platform 
trajectory; it is shown that the optimization of this function depends on neither the IRF nor 
the measurement variance at the platform side; that is, the exact^ information to identify 
the platform trajectory is unnecessary. 

• Also it is demonstrated that the platform trajectory is unobservable unless it keeps a constant 
speed during its two different legs. 

• We use an efficient and practical algorithm, based on a derivative-free local search, to solve 
the nonlinear problem associated with the identification task. The local optimization routine 
is initialized from geometric considerations and exploits the structure of the observed FIM. 

The paper is organized as follows: In Sec. II we introduce the model for passive wideband-sonar 
localization and we give the background on the ML-PDA approach; in Sec. Ill we formulate the 
problem of inverse localization and we show some important identification properties; in Sec. 
IV we devise a procedure to compute a good initial estimate as input for the local optimization 
routines, while in Sec. V we show, by simulation, the performance of the proposed solution; 
some concluding remarks and future research are given in Sec. VI; proofs and derivations are 
confined to the Appendices. 

Notation - Lower-case (resp. Upper-case) bold letters denote vectors (resp. matrices), with a„ 
(resp. An^m) representing the nth (resp. the (n, m)th) element of the vector a (resp. matrix A); 
upper-case calligraphic letters and braces denote finite sets, with [a : h], a < h, representing 
the set {a, a + 1, . . . , 6}; /jv denotes the N x N identity matrix, while diag (t) is a diagonal 
matrix with diagonal equal to t; (O^^ II' II 2' IMIf ^^^ (') denote transpose, £2 norm, Frobenius 
norm and inner product operators, respectively; Vt(-) denotes the gradient operator w.r.t. the 
vector t; e^{A,i) denotes the unit eigenvector of a symmetric (and thus diagonalizable) matrix 
A (of size [r x r]) corresponding to the eigenvalue Xi, i E TZ = {1, . . .r}, where A^ > A^+i, 
s E TZ\{r}, and j E { — 1, 1} denotes the sign ambiguity in the eigenvector formula; arctan2(a3), 

'We will show however that for devising an efficient local-optimization algorithm a range of variability should be given; 
however the width of this range does not affect significantly the performance. 
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X E M?, denotes the four-quadrant inverse tangent with argument — ; P(-) is used to denote 
probability mass functions (pmf) or probability density functions (pdf), while P(-|-) is the 
corresponding conditional counterpart; J\f{fi, S) denotes a real normal distribution with mean 
vector fi and covariance matrix S; finally the symbols — )>, 3, ~, and ± mean "maps to", "such 
that", "distributed as" and "orthogonal", respectively. 



II. System Model 
A. Motion Models description 

The system model is described graphically in Fig. 3. We assume that the target is observed 
by the platform at n time samples, i.e. t E T = {ti, . . . , t„}; also we define the set of indices 
X = {1, . . . , n}. In the following we will explicitly list all the assumptions made, starting from 
the motion models of the platform and the target. 

Assumption I: We assume that the target moves according to a constant velocity (CV) motion 



model [1]. For this reason we define priU 



^t{U) iit{U) 



and vt 



ir Vt 



as the 



position at ti and the (constant) velocity 2-D vector of the target; ^ and i] are used to denote 
the east and north directions. Given the CV assumption, {pTiti),PTitn)} uniquely define the 



PrihY pritr 



, which 



state of the target at ti E T . Therefore we stack them in Xt — 

represents the true target state vector, unknown at the platform side. The target motion model 

has the explicit expression: 



iT{U 
VriU 



Priti) + {ti - h) ■ Vt 
{ti - ti' 



pAti 



{tn — tl 



[pAtn) - PAtl)] , t,ET 



(1) 

(2) 



Assumption II: We assume a platform moving according to a "two-leg" motion model; this 
requirement not only ensures observability of the target from the platform point of view [23], 
[24], but also represents the easiest trajectory that can be followed by the platform. We denote 



Pp{ti 



ip{ti) r]p{ti 



VPA 



and Vp2 



^P,2 VP,2 



, as the position 



pp{tiY i^pi v\ 



P,2 



Cp,i Vp,i 
at ti E T, first-leg and second-leg velocity vectors; also we group Xp 
into the platform state vector, representing the unknowns at the target-friendly side. Note that 
Xp does not uniquely define the platform trajectory, since the turning time tk is also needed. 
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Assumption III: Throughout this paper we will make the simplifying assumption that t^ is 
known at the target-friendly side. In fact it is reasonable to assume that tk in practice will happen 
nearly the middle of the observation interval, i.e., tk ~ *"^*\ in order to assure a good degree 
of observability^. This assumption will be relaxed in Sec. V, where a sensitivity analysis with 
respect to (w.r.t.) the timing-uncertainty on tk will be shown. Therefore, once tk is assumed to 
be known, the platform motion model is explicitly described as 



VpiU 



pp{ti) + {ti - ti)vp^i tieT,3 ti< tk 

(3) 
ppih) + (tk - ti)vp,i + {ti - tk)vp^2 tieT,3 ti> tk 



Note that here the magnitudes of vp i and i>P2 are arbitrary. As shown later, unique identifiability 
of the platform trajectory (our goal) requires these magnitudes to be the same, i.e., the platform 
speed should be constant. 



B. ML-PDA statistical assumptions and formulation 

The statistical assumptions on the measurements are summarized as follows. 
Assumption I: The bearing (true — originated from the target) measurement /tj, collected by 
the platform at tj, follows the model 

Ki = 6i{xT, Xp) +ni = arctan ( '^ \ ^^— ^ ] + n, (4) 

where 9i{x'r,xp) denotes the noise-free bearing (we stress the dependence on both platform 
and target state vectors) and n^ ~ A/'(0, aj). For notational convenience we also define here the 
range ri{xT, xp) as 

ri{xT,xp) = Wpriti) -pp{ti)\\^ (5) 

Assumption II: We assume, as in realistic environments, that a passive sonar at ti E T collects 
a set of measurements z{i), due to clutter and non-perfect detection. More specifically, we have 

z{^ = MW=i (6) 

^In fact, a turn at the beginning or tlie end of tire observation interval would result in a platform trajectory similar to a single 
leg (CV model), thus leading to a nearly singular FIM. 
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Figure 3: System model considered for our application. The crosses refer to the bearing 
measurement at snapshot tj G T. 



where nii denotes the number of collected measurements at tj G T. The statistical assumptions 
over the set in Eq. (6) are: (z) the true measurement ki can be detected at most only once, with 
probability Pd\ (U) the number of false measurements at tj G T follows a known probability 
mass function jj^pi'), given by a Poisson law with known expected number of false alarms per 
unit of volume A; therefore the false measurements are distributed uniformly and independently 
in the surveillance region (in the bearing space). 

Assumption III: We assume conditional mutual independence among the sets of measure- 
ments, that is P{z{ii),z{i2)\xT,Xp) = P{z{ii)\xT,Xp)P{z{i2)\xT,Xp), Wii ^ i^. 

Under these assumptions and denoting xt (resp. xp) as the true target (resp. platform) state 
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vector, the ML-PDA estimate xt is obtained as 



n^( 



Xt = argmax I I r[^z[i)\XT,Xp) 

XT -'- -'- 

j=0 



(7) 



where the likelihood of Xt is given by: 

P{z{i)\XT,Xp)=U-'"'\l-PD)Mm) 

u'-^'^PDflFJm, - 1) y\ 1 



+ 



m,: 



1 fZj{t) -ei{XT,Xp) 

X exp -- ^ ) 1 (8) 



Note that xp is assumed known at the platform side. It was shown numerically in [17] that 
the covariance matrix of the ML-PDA estimator essentially attains the CRLB and therefore it 
can be regarded as an efficient estimator. For this reason, the covariance matrix is approximated 
by the inverse of the FIM given by 



J{xt, Xp, ag) = «e ^ '^xridiixr, xp))Vl.^{9i{xT, xp)) 



(9) 



i=0 



= JuixT,Xp) 



where ag is defined as^ 



A 92 



(10) 



with g2 representing the IRF [17], [2]. Note that 

q2 = q2{\Vg,PD,g) (11) 

where Vg and g denote the volume of the validation region and the gating threshold, respectively. 
It can be shown, after some manipulations, that 'VxT{9i{x'r,Xp)) has the explicit expression 

[1 - ai)cos{6i{xT,xp)) 
1 



Xt \^t 



'xT,Xp)) 



rdXT^Xp) 



(12) 



-(1 - ai)sm.{ei{xT,Xp)) 

aiCos{di{xT,xp)) 

-aiSin{6i{xT,xp)) 

The FIM at the platform side is necessarily evaluated as J°^^ = J(xp,XT,ag), where ag 
denotes the true ag, known at the platform side. Given the results of the estimation process at 
the platform side, that is {xt, J"^'^}, our task can be summarized as follows. 

^Note that ao should not be confused with Oi — *' ~*^ defined in Eq. (2). 
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We wish to identify the platform state, represented by Xp, by observing only the estimation 
results of the ML-PDA, that is {xt-, J°^^}. It is worth remarking that the unknowns of this 
deterministic problem are represented by {xp^ae}. In fact, even if ae does not contribute to 
specifying the platform trajectory, it has to be identified to solve this task. 

The first important remark is that the identification problem is a function only of xt rather 
than the true trajectory xt- This has an important consequence: the identification of the platform 
trajectory does not depend on the true target trajectory Xt! however we will show that due to 
the sensitivity w.r.t. the true platform parameters, a larger FIM matrix will lead to an easier 
identification in terms of local optimization routines. 

III. Objective Function Determination 

As a starting point of the identification problem, it would be natural to solve the non-linear 
equation 

J{xT,xp,a0) = J"''' (13) 

for the variables xp and ae. However, as stated by the following proposition, we will show 
that this system is unobservable, since there exists an infinite number of solutions satisfying Eq. 
(13). 

Proposition 1. If {x*p,al} is a solution of (13), then each {xp,ag} generated by the subspace 

{xp,as} = {(3x*p + {l-P)xE,P'a;}, /3 eR (14) 



- A 

Xe = 



PritiY V*T *T 



(15) 



is also a solution of (13). 



Proof The proof is given in Appendix A. ■ 

The above proposition states that no unambiguous identification of the platform trajectory xp 
is possible when the platform is following a trajectory according to Eq. (3) with different speed 
in each leg. The explanation of this is given by the fact that an affine combination (through (3) 
of the platform and the (augmented) target state vector would produce the same FIM with an ae 
scaled by /3^. At this point it is worth stressing the difference between this requirement and the 
target estimation, in which the platform maneuver is the only prerequisite to ensure observability 
of the target by the platform. 

April 10, 2013 DRAFT 



11 



However, when both legs of the platform trajectory are constrained to have the same speed s, 
that is 

(16) 



■s = vp,i 



*^P,2 



we can show that the subspace described by Eq. (14) violates constraint (16), if the specific 
condition 

(vp,i - Vp,2)*i)T ^ (17) 

holds. The latter represents the condition under which the difference vector of the two legs 
velocities is orthogonal to the velocity vector of the target; such a trajectory would make the 
platform unobservable, even though the constraint in Eq. (16) is satisfied, and thus it should be 
intended as a stealthy trajectory achievable by the platform"^. To demonstrate this, let us consider 
the squared speed of the two legs for a platform trajectory belonging to the subspace in Eq. 
(14): 

2 



V 



P,l 



V 



P,2 



/3^ ||«P,i||^ + (1 - py WvtW, + 2/3(1 - /3)*>P,i 
13^ \\vp4l + (1 - /3)2 \\vr\\l + 2/3(1 - /3)v'r'^p,2 



(18) 
(19) 



If we constrain the true platform trajectory to keep constant speed during the two legs, evaluating 

|2 II / ||2 



the difference \\v 



P,l|l2 



|i>P2|| leads to 



V 



P,i 



V 



P,2 



2/3(1 - /3)vi^ {vp^, - vp,2 



(20) 



From inspection of Eq. (20), it is apparent that a platform described by Eq. (14) keeps a constant 
speed in the two legs only if: (i) (3 = 1, i.e. the trajectory considered coincides with x*p; (ii) 
(3 = 0, which represents a degenerate platform trajectory and thus it can be excluded; (Hi) 
vt -L (i'p,i — i'p,2)- For this reason, under the assumptions in Eqs. (16) and (17), identification 
of the platform trajectory is possible. More specifically, the constraint in Eq. (16) represents a 
necessary condition for observability of the platform trajectory. On the basis of this constraint 
we define a new platform- state vector Xp (and we denote the true platform- state vector as £p) 

''obviously, design of such platform trajectory would require in advance the knowledge of the estimated target trajectory and 
thus it is not performable in practice. 
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as follows 



X p 



^p{ti) Vp{h) s 



(21) 



Thus Eq. (13) becomes 



arctan2 (i'p,j) , i G {1, 2} (22) 



J{x%,ae) = r'' (23) 



with unknowns Xp and ao (starting from here we drop the dependence on x^ to keep the 
notation simple). In general, the non-linear system described by Eq. (23) can still admit multiple 
solutions, since there is no theoretical proof that the set of constraints in Eqs. (16) and (17) is also 
a sufficient condition for observability of {xp.ae}. This is because proving that {xp^ag] — )> 
J{xp, ae) is a one-to-one mapping is an extremely difficult task. Nonetheless, we will show, 
through simulations in Sec. V, that this property seems to be satisfied and that x% can be 
identified. 

To solve Eq. (23) in an efficient way we consider the search for the minimum of the square 
of the Frobenius norm J-'{xp, ae), namely, 

{xp,ae} = arg min 11 J"^"* - J(xp, a^) 11 (24) 

{Xp,ag}^ ^ / 

=J^{x''p,ag) 

It is easy to see that the global minimum (corresponding to a zero value) of Eq. (24) 
corresponds to the solution of Eq. (23). Although the criterion of Eq. (24) appears as arbitrary 
(in fact other matrix distance norms can be considered), there is an important reason behind 
this choice: we will show in the following that J-'{xp, ag) (see (27)) can be expressed in terms 
of a weighted-square-distance, and an important property of weighted non-linear least squares 
problems can be exploited [20]. 

The first step to express Eq. (24) in terms of a convenient weighted-least squares problem is 
to search for independent entries of J{xp,ag). The following Lemma will be used. 

Lemma 2. The FIM J{xp, ag) has only 9 independent entries. 

Proof: The proof is given in Appendix B. ■ 

Exploiting Lemma 2, we can express Eq. (24) in terms of a weighted-square distance, as 
stated by the following proposition. 
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Proposition 3. The square of the norm in Eg. (24) can be equivalently written in the form 

HxU(^e)= [r'"'-3{x%,ae)\'w[f'"-3{x''p,ae)\ (25) 

where j°^'^ G M^ and j{xp,ag) G MP are obtained by stacking the independent components of 
J{xp,ae) and J°^^, respectively and W is a diagonal weighting matrix, defined as follows: 

1 1^ 



W = dias 



111122422 



(26) 



Proof: The proof is given in Appendix C. ■ 

Note that j{xp, ae) retains the same factorization as J{xp, ae), that is, j{xp, ag) = aejuixp), 
where ju{xp) is defined accordingly to Eq. (9). Hence Eq. (25) can be rewritten as 

J'ix},, ae) = [r'' - aejuixp)] * W [f' - aeUx^)] (27) 

Note that the minimization of the objective function in Eq. (27) is in the standard form of 
non-linear weighted least squares [20]. Additionally in this case the non-linear weighted square 
distance is linear in some of the parameters to be estimated, in this case ag, and thus this 
non-linear problem can be solved in a reduced dimension space; the details are given by the 
following proposition. 

Proposition 4. The minimization in the 6-dimensional space of the objective J^{xp, ae) is 
equivalent to maximization of the objective Q{xp), defined as 

g{x^p) 4 {r'\c{x%)f (28) 



_Wju{x'p 

X 

Proof: The proof is given in Appendix D. 



cix%) ^ " j-y-Fj (29) 

[Ux^pYWUx^p)]''' 



The maximization of Q{xp) has the advantage of reducing the search space from M^ to M^. 
The exclusion of ae also allows a search only in the subspace of variables determining the 
platform trajectory. At this point some observations on the objective function in Eq. (73) are in 
order: 

• The function Q{xp) is highly non-linear in x^p, therefore no closed form solution to 
optimization of Eq. (28) exists; thus numerical optimization procedures need to be used; 
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• Local optimization routines can get stuck in local maxima or other (non-equilibrium) points^. 
An important issue in local optimization routines that determines their success, is the choice 
of a good initial guess. In the following we will suggest a good start, based on the FIM and 
platform-target geometry. 

IV. "Geometry-driven" FIM-aided initial estimate choice 

In this section we show how a good initial estimate, denoted as Xp , can be chosen to help 
the convergence of the local optimization routines. To accomplish this task define 



A 

Pp = 



PpihY PpitkY pp(tr 



\t 



(30) 

\\Pp{tk)-Pp{tl)\\2 _ l|Pp(*n)-pp(ffc)|l2 



Since it is easy to show that there is a one-to-one mapping between pp and Xp, we will search 
for a Pp close to pp (even though the latter is not known), as the equivalent input to the local 
optimization routine. For this reason, we first will find good approximations Pp{ti) and Pp{tn). 
After this, we will give the details on how to find Pp{tk), under the constraint of Eq. (30). 
The following considerations are based on the assumption that ag is known; at the end of the 
section we will remove this restriction. In the following, for the sake of simplicity, we will 
use the short-hand notations r^ = ri{xT,Xp) for the range, 9i = 9i{xT,Xp) for the bearing. 



• A 
I,- = 



sm [Oi) cos I 
p% and Pp{ti). 



for the bearing unit vector, and we will drop the zero superscript in 



A. Choice of pp{ti) and pp(tn) 

It can be easily shown that {pp{ti),pp{tn)} can be expressed in the form: 

Pp{ti) = PT{ti)+riii (31) 

Ppitn) = PT{tn)+rnin (32) 

In order to obtain good estimates {pp(ti),pp(t„)} we need to find good approximations 
{f'i,f'n} and {ii,in}. These issues can be tackled separately. 

^In fact, several local optimization routines are not based on the evaluation of the gradient vector of the objective function at 
each iteration, thus a "null gradient" condition is not ensured when a stopping condition is met. 
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Choice o/{fi,f„}.- A coarse approximation of the ranges ri and r„ is given by: 



ri 



'«.Er=i(i 



«,: 






(33) 



tr(J°^^[l,l]) ' y tr(J°^^[2,2]) 

where J°*''[m, n] represents the (m, n)th [2 x 2] block matrix of J°^*, whose explicit expression 
in block form (exploiting the derivation in Appendix B) is given as follows: 

jobs^2,l] J°^^[2,2] 



robs 



(34) 



ae 



ad'^y-iVl 



Er=i(i 






where 



Vi 



cos{9i{xT,x^p)) -sin(6'j(*T,*p)) 



(35) 



(36) 



ri[X'r, Xp) 

The term tr ( J°^'^[l, 1]) (resp. tr (j°^*[2, 2])) represents the sum of the eigenvalues of the FIM of 
Prih) (resp. pritn)), that is, the sum of the square of the semiaxes of the corresponding ellipse. 
The terms in the numerators of Eq. (33) are correction factors which avoid biased estimates fi 
and f„. The derivation of Eq. (33) is given in Appendix E. 

It is worth remarking that Eq. (33) represents a rough approximation of {ri,r„}; however, as 
we will show in Sec. V, the accuracy obtained is sufficient to determine values close to pp{ti) 
and pp{tn) in all the practical scenarios considered. 

Choice of {ii,in}: By defining C"^' = (j°^^)~^ and denoting C°^^[£,m] as the {i,m)th 
[2 X 2] block matrix of C°*'^ we have that: 



i{^eP{C"'^[l,l];l), 



il^e^{C"''[2,2];l); p,q e {-1,1} 



(37) 



Note that C°^*[l, 1] (resp. C°'^^[2, 2]) is a lower bound of the covariance matrix of any unbiased 
estimator of px(ti) (resp. pritn)) and thus the eigenvector corresponding to the largest eigenvalue 
represents the axis of maximum uncertainty, i.e., the one along the range between the platform 
and the target. The indices {p, q} underline the incomplete information about {ii, in} contained 
in the FIM, which intrinsically leads to a sign ambiguity (because if e is an eigenvector, so is 
— e). The derivation of Eq. (37) is given in Appendix F. 
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Figure 4: Graphical description of Eq. (38): cases (i) and (ii) satisfying it. 

It is apparent that the sign ambiguity in Eq. (37) would lead to four possible pairs {i^,i^}. 
However, in practical scenarios the sign-ambiguity leads to only two pairs if we assume that the 
following vector equation has no solution: 



C ■ Priti) + (1 - C) ■ Pritn) = Pp{ti); Vt^ G T, C e 



(38) 



Eq. (38) admits solutions only in the following cases^: (i) the platform trajectory and the target 
trajectory have at least one crossing point; (ii) the platform is crossing the line representing the 
direction of the CV target trajectory, determined by its velocity vector vt- These scenarios are 
graphically depicted in Fig. 4. While the former case represents a totally unrealistic scenario (the 
platform and the target would be too near), it can be shown that the latter is of little interest, 
since such a platform trajectory would lead to poor observability of the target [24]. 

Therefore the only two admissible pairs are obtained as follows: let us define a vector {u E 
IS.^ : u ± Vt,\\u\\^ = 1} and take the pairs {i^, i^} satisfying 

sign ^i?, u^ = sign {^i^, u^ , p,qe {-1,1} (39) 

In the following we denote as {if, i^}, g E {1, 2}, the resulting two pairs. Thus, exploiting Eqs. 

^Although Eq. (38) refers to priti), the same applies to priti) under the assumption that the platform obtains a reasonably 
"confident" estimate of the target. 



April 10, 2013 



DRAFT 



17 



(33), (37) and (39) we obtain: 




pUti) - 


= priti) + fi ■ il, 


P%{tn) = 


= Pxitn) + f-n ■ tl 



9e{l,2} 
9e{l,2} 



(40) 

(41) 



B. Choice of turning position vector pp(tk) 

As pointed out previously, Eqs. (40) and (41) define two pairs {Pp(ti),Pp(t„)}, g E {1,2}. 
Hence for each {pp(ti),Pp(t„)} a corresponding Pp{tk) needs to be computed. In this case 
it can be shown that Pp{tk) cannot be chosen only relying on the geometric properties of the 
FIM, as opposed to pp{ti) and pp{tn). Rather, a ±| platform turn initial assumption is made 
and the turn-sign ambiguity is solved exploiting the coarse information in the FIM. By defining 



tm — argmint-gr \\ti — *"^*^ ||^, such a vector is obtained as (we drop the superscript g) 



Pq{h 



{tk 



Pp{tk) = 
peXtk) = pp{ti) + j^ ^ ||pp(t„) -pp(ti)||2Cosi 



(tn — tk) 

arctan2 {pp{tn) - ppih)) 



sin {^pi) 
cos {tpi] 



TT 



— V 



A , I tk —tl 

V = arctan , 

''n '^k 



arg min ||pp(t„) - p^(tm)||2 



(42) 
(43) 

(44) 

(45) 
(46) 



where pe{tm) is the position vector at t^ of the two-leg trajectory described by {pp{ti), pi{tk),pp{tn)}, 
and pp{tm) is given by 



Pp{tm) = Pritr. 



m "m 



'^eYH=l(^i{^ - (^i 



tr(J°^^[l,2]) 
L = e''(J°^^[l,2];l) 
q 3 sign (e^ ( J°^^[l, 2]; l) , t.) = sign (i,, it) , j G {-1, 1}. 

The complete derivation of the selection of Pp{tk) is given in Appendix G. 



(47) 

(48) 

(49) 
(50) 
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C. Remarks on ag 

r 1 * 

The presented method computes pp = Pp{tiY PpitkY PpitnY , 5* G {1, 2}, under the 
assumption that ag is known at the target-friendly side. However, since ag is known exactly 
only at the platform side, we will replace ag with the variable ag in Eq. (33), thus leading to 
Pp = Pp{o^e), !•£•, a continuum of initial guesses. Therefore, in order to obtain a (small) finite 
set of initial guesses we apply the following steps: 

1) define a uniform grid of Ng values on ag, constrained in the interval [ag.min) tt6i,max]' and, 
after denoting the m-th value as ag[m] = ae^min + ^;z^(«e,max - ae.min), m e Sg = 
{1, . . . , Ng}, we compute pp{ag[m]), g G {1, 2}, m G Sg; 

2) split up the set p^p{ag[m]), m G Sg,g G {—1,1} into three subsets, corresponding to zones 
(a), (b) and (c), defined as follows^: (?) we split pp{ag[m]) into two sets Pp~ (aei^]) and 
Pp~" {ag[m]); (ii) by defining Tm,g = arctan2 (pp(t„, a^M) - Ppiti,ag[m])) we seek 
for {m*,g*} 3 sign{T m* ,g'') 7^ sign(r(m.+i)_^*); (in) we split the set corresponding to g* 
as p'^p{ag[l : m*]) and p^p{ag[{m* + 1) : Ng]); 

3) choose, from each defined subset, the guess corresponding to the maximum of Eq. (28), 
and denote the obtained triple as {Pp,Pp,Pp}, which is fed (possibly in parallel) to a 
local optimization routine. 

A good choice of Ng can be obtained as follows. We first observe that the worst-case error in 
grid sampling of ag is given by Asg = 2-(JV~°i'r'" ' ^^^^ error is negligible in Eq. (33) when 
ag :$> Aeg, thus leading to Ng ^ "fl,ma^-ae,m»n _|_ j^ However, since ag is not known, we can 
consider the conservative inequality agmin ^ ^^e, which leads to Ng ^ i '^e,mirz+ae,max ^ 

V. Simulation Results 

In this section we consider two scenarios, taken from [1], to corroborate the theoretical results 
presented and show the performance of the geometry-driven initial guess procedure. In both 
scenarios {i) and {ii) we assume the same xt (since the absolute position is irrelevant, only the 
relative geometry), while we consider two different Xp (see Table I). In Table I we report the 

^The values {a^^min, Qe,max} are obtained automatically, once a reasonable range is given for parameters concurring with 
the definition of ag (e.g. og); an example will be given in Section V. 
'*Note that the definition of the zones is arbitrary. 
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Table I: Parameters known at the platform side. 



Parameter 


Value 


Unit 


tn -^ tl 


800 


s 


t, - t^-u i e l\{i} 


4 


s 


Xp in scenario (i) 




10'' 2-10" 7.1 fyr ^ 


t 




m m m/s rad rad 


t 


Xp in scenario (ii) 




10" 2- 10" 7.1 -f f 


t 




-1 1 
m m ™/s rad rad 


q2{\Vg,PD,g) 


52(0.3,0.9,5) = 0.814 


dimensionless 


ere 


1 (0.0175) 


deg. (rad) 


ae = "^/'tI 


2.6580 • 10=' 


rad^2 



Table II: Parameters known at the target-friendly side. 



Parameter 


Value 


Unit 


tn-tl 


800 


s 


t, -t,-i, iel\{i} 


4 


s 


XT 


[ 15 X 10=' 35 X 10=^ -10 5 1* 


[ m m m/s m/s ]* 


k 


101 


dimensionless 


92* 


G [0.652,0.982] 


dimensionless 


ag* 


G [1,2] (G [0.0175,0.0350]) 


deg. (rad) 


ag* 


G [532.2449,3206.5] 


rad~^ 



list of parameters known at the platform side; it is worth noting that ae is completely specified 
by q2 (obtained as in [17, Table II]) and a^. 

In Table II we report the list of parameters known at the target-friendly side, after intercepting 
the ML-PDA estimates. The interval [a6i,min, a6i,max] (needed to obtain the initial guesses in the 
three zones) is obtained as follows. We assume that the target-friendly entity possesses the coarse 
information ag E [1,2]° and q2 E [0.652,0.982] (under the assumptions^ that \vg E [0.1,0.5], 
Pd e [0.8, 1], g = 5, cf. [17, Table II]), thus leading to ae E [532.2449, 3206.5] rad-^. 

The guesses {Pp,Pp,Pp}, obtained with the approach described in Sec. IV and setting Ne = 

'Note that in Table II the asterisk indicates that those parameters are only needed to compute wise initial guesses for the local 
optimization procedure, but not for the maximization of Eq. (28). 
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5^°, are given as input to the Nelder-Mead simplex method [22], which seeks for a local maximum 
of the objective function in Eq. (28). This local optimization routine has been chosen because 
it is a derivative-free method, as opposed to Newtonian and quasi-Newtonian local optimization 
routines. Such a choice avoids the evaluation of the Jacobian matrix (and also of the Hessian 
matrix, in the Newtonian approaches), which is composed of 45 entries, thus requiring extensive 
computations. 

Fig. 5 presents a plot of the platform and target trajectories for scenario (i), while Fig. 9 
shows them for scenario {ii). It is worth noting that scenario (i) represents a low-observability 
case, while scenario {ii) has good observability, as shown through the 95% confidence ellipses 
oi pT{ti) and pritn) in Figs. 5 and 9. 

In Fig. 6 (resp. Fig. 10) we show the initial estimates corresponding to zones (a), (b) and 
(c) (defined in step 2) of Subsec. IV-C) of the platform trajectory (28). It is apparent that the 
initial estimate corresponding to the true zone (i.e. the zone where the true platform trajectory 
is) is near the true platform trajectory in both cases; incidentally a degree of similarity is also 
present in the estimate corresponding to a different zone in scenario {ii) (zone (6), cf. Fig. 10). 
Nonetheless, in both cases the procedure produces a very good initial estimate corresponding to 
the zone where Xp belongs, which bodes well for a local optimization routine. 

The convergence properties of the algorithm are illustrated in Figs. 7 and 11 for the three 
different initial estimates, and the performance is analyzed in terms of the time-averaged root- 
square position-error (RSPE) defined as 

1 " 
RSPE(m) ^-y^\\p^{u)-pp{u)\\^ (51) 

1=1 
with Pp(-) denoting the output of the local optimization routine after m iterations. It is apparent 

that there is no monotonic decrease of the RSPE, since the maximization of the objection function 
is conducted w.r.t. the vector Xp\ however convergence is observed with an acceptable number 
of iterations (recall that there is no need to compute the Jacobian at each iteration and so each 
iteration is very light from a computational point of view). In Fig. 8 (resp. Fig. 12) we finally 
show the platform corresponding to the maximum of the three outputs obtained with the Nelder- 
Mead method and the three different initial estimates. It is apparent that in both the scenarios 

'"it is worth remarking that in such a case "^'""^^ ""'""" + 1 ~1.5, thus Nq = b for this particular scenario is a fair 
choice. 
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Figure 5: Platform and target trajectories considered for scenario (i). 



the true platform trajectory is identified exactly (recall that this is a deterministic problem); such 
results confirm our conjecture on the uniqueness of the Eq. (23). 

Turning time tk sensitivity analysis 

In this paragraph we will remove the assumption that the turning time t^ is known at the 
target-friendly side and we will show the effects of a grid search for the turning time index, 
denoted as k, for both scenarios (z) and {ii). Figs. 13 and 14 show the RSPE (obtained as the 
minimum along the three zones) as a function of the assumed index k. It is apparent that the true 
platform trajectory is still identifiable in both scenarios; however the RSPE w.r.t. to the index 
k is not a unimodal (discrete) function and therefore no "naive" golden-search method can be 
applied to identify the platform; rather a parallel approach is needed. 

Finally it is worth noting that the overall complexity H of the proposed approach is given by: 



fc=i 



y^ UJa{k) + UJh{k) + UJc{k) 

=1 

n 

^Xa{k) + Xb{k) + Xc{k) 



uji{k) 



k=l 

^ ■ Xi{k) 



(52) 

(53) 
(54) 
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Figure 6: Geometry-driven initial guess procedure for platform trajectory in scenario (i). 
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Figure 7: RSPE as a function of the number of iterations for scenario (i). 
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Figure 8: Identification results for scenario (i). 
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Figure 9: Platform and target trajectories considered for scenario (ii). 
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Figure 10: Geometry-driven initial guess procedure for platform trajectory in scenario (ii). 
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Figure 11: RSPE as a function of the number of iterations for scenario (ii). 
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Figure 12: Identification results for scenario {ii). 

where Uiijz) denotes the complexity of the Nelder-Mead method with initial estimate belonging 
to zone i and assumed index k. Note that Uiik) is simply given by the complexity of the single 
iteration w, multiplied by the number of iterations Xi{k)- It is worth noting that there is no 
convergence theory to support an analysis providing an estimate for the number of iterations 
required to to satisfy any reasonable accuracy constraint, given as a stopping condition [27]. 
Instead, regarding the complexity of the single iteration, it has been proved in [27] that to has 
a complexity which is only dependent on the dimension of the search space, which is five- 
dimensional in our case (since Xp E M^). 

VI. Conclusions 

In this paper we studied the problem of identifying the platform motion from its ML-PDA 
estimation results on an observed target — the estimation of the stealthy estimator. We have 
addressed only the common "two-leg" platform trajectory (see Figs. 1, 2, 3, 4 etc.); a similar 
analysis could be performed to other platform trajectories (such as a constant speed turn). 
We demonstrated that even a general "two-leg" platform motion model can lead to ambiguity 
in the identification; however, imposition of the constraint of constant speed motion ensures 
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Figure 13: Sensitivity analysis in scenario (i). 



S 



. Lmllllll ill 




JOO^ 120 



140 160 180 200 



Figure 14: Sensitivity analysis in scenario (ii). 
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observability of the platform in most of the scenarios. We modelled the problem as a Frobenius 
norm minimization and we found a convenient objective function, exploiting the FIM elements 
and independent on the platform measurement-related parameters, namely olq. Also, we devised 
a procedure for the choice of a very small set of initial estimates as input for the numerical 
optimization procedure, on the basis of theoretical considerations on the geometry of the FIM. 
Finally, we corroborated the theoretical findings and we have shown the effectiveness of the 
approach for the choice of the initial estimates, through simulation results. Future research will 
tackle incomplete (and noisy) intercepted information and different platform motion models. 
Note that although we have taken the ML-PDA as the underlying algorithm this is only in 
attempt at generality. In fact, the results presented here apply also to situations with any degree 
of measurement origin uncertainty, including of course the situation of a deterministic target 
observed via "clean" measurements without false alarms or missed detections. 
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Appendix A 
Proof of Proposition 1 

To prove this proposition let us assume that there exists a solution {x*p, a^} such that J{xt, x*p, a^) 
jobs_ Now let us consider the subspace {xp,ag} defined as 

{xp,a'f)} = {Px*p + {l-P)xE,P^a;}, /3gM (55) 



where xe 



PritiY vtp u 



. The subspace contains the set of platform trajectories whose 
velocity and position vectors are linear combinations of the ones of the platform trajectory defined 
by x*p and the estimated target trajectory. 

In this case the corresponding 9i(xT,Xp) and ri(xT,Xp) have the explicit expressions 

[iritd - (Kp{ti) + (1 - mAtS 

6i(xT,Xp) = arctan ^ , , )— — — ; ^, ^ , /, 

^ "^^ yvAu) - iPMu) + (^ - P)vTiu)) 

= e,ixT,x*p) (56) 
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n[^XT,Xp) = y yiriU) - [(3ip{ti) + (1 - mriU))) + {iiriU) - {/3r]p{U) + (1 - /3)fiT{U))y 
Pr,ixT,x*p) (57) 



By plugging Eqs. (56) and (57) into Eq. (12) we obtain the equality 

Va,^{9i{XT,x'p)) = -Va:TiOi{XT,X*p)) 

Using Eq. (58) we can express J(xT,Xp,aQ) as 



J{xT,Xp,ag) 



{P'a;)J2^^^Tm^T,x*p))^Vi^{e.{xT,x*p)) 



J{xT,x*p,al) 



(58) 

(59) 
(60) 



Since {x*p, a^} and {x'p, a^} (independently of j3) lead both to J"^^, J(-) does not represent a 
one-to-one mapping, which makes the platform-state vector xp unidentifiable. 

Appendix B 

Proof of Lemma 2 

We start by observing that JixT.Xp.ae) and Va;y(^j(^T, a^p)) can be expressed similarly 
as Eqs. (9) and (12). Also, for notational convenience let us define 

1 



ri{xT,x%) 
and rewrite '^xri^iixT-iXp)) as 



cos{9i{xT,x%)) -sin(6'j(^r,a;|,)) 



(61) 



XT \ * 



' XT, x'p)) 



(62) 



J{xT,Xp,ae) 



(1 - ai)yi 
OiiVi 

where a^ has been defined in Eq. (2). Substituting Eq. (62) into the explicit form of J{xt, Xp, ag) 
we get 

■"7(1,1] J[l,2] 
J[2,l] J[2,2] 

Er=i(i - (^i)^yiyi Er=i "i(i - (^i)yiyl 
Er=i "i(i - "i)?/i?/* Er=i ^i^yiyi 

where we have elucidated the block-decomposition arising from Eq. (62) into [2 x 2] matrices 
J[i,m], £,m E {1,2}. Since we have that J[l,2] = J[2, 1], only three matrices contain non- 
repeated entries (i.e., the 4 entries of J[l,2] or J[2, 1] can be neglected). Also, since J[l, 1], 



ae 



(63) 



(64) 
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J[2, 1] and J[2,2] are symmetric matrices, there is a repeated entry in each of them, thus 
leading to 3 other dependent entries. Therefore the 16 entries of the FIM actually contain only 
9 independent elements. W.l.o.g. we consider here (and throughout the paper), the following 
independent entries (we drop the dependence w.r.t. x^, Xp and ag) and we denote with C the 
corresponding set of indices: 

{<^l,l, J2,2, J3,3^ J4,A, Jl,2, Jl,3^ Jl,A^ <^2,45 JsAJ (65) 

Appendix C 
Proof of Proposition 3 

We have shown, through Lemma 2, that J{xp, ag) has only 9 independent entries. Also, 
the dependent entries are simple repetitions of the corresponding independent entries, due to 
particular symmetry structure of the FIM (cfr. Eq. (63)). 

The same argument extends to D{xp,ag) = (j°^'^ — J(xp,ag)) and its entry-wise squared 
version D{xp,ag) (i.e. Di^m(xp,ag) = Dj^{xp,ag)), ijf J°^'^ retains the same property of 
symmetry; this is accomplished if J°^'^ is a noise-free observed FIM, that is J"*"* = J(xp,ag). 

By construction, the following equality holds 



\J'''' - J{x%, ag)\\l = J2Yl D^,^{x%, ag) (66) 



jobs 1 ( r^s „, A 11^ 

£=1 m=l 

This sum can be efficiently evaluated by considering only (£, m) E C, with C being the set of 
the independent entries according to Eq. (65), and weighting them by the number of times they 
are repeated in the matrix D. Thus the l.h.s. of Eq. (66) can be rewritten as 

J2 Yl We,mDe,m{x%,ag) = J2 E W,,m{Jt:.-'Ji,m{^p,(^e)Y (67) 

(e,m)(^c {e,m)ec 

By stacking the elements J^^^ (resp. Ji^mixp,Oig)), {i,m) E C, into the vector j"^"* (resp. 
j{xp,ag)), and defining the diagonal matrix W with elements We-m, we obtain the weighted 
form of Eq. (25). Finally, it is straightforward to show that W has the expression 



W = diag 



11112 2 4 2 2 



(68) 



where the weight equal to 4 accounts for the repeated elements along the minor (secondary) 
diagonal, while the weights equal to 2 account for the remaining symmetric entries into each 
block matrix J[£,m], i,m E {1,2}, and between the matrices J[l,2] and J[2, 1]. 
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Appendix D 
Proof of Proposition 4 

Let us rewrite Eq. (27) here for convenience: 

F{x%,ae) = [f'-''-3u{x-''p)ae\'w[f'-''-ju{x%)ae\ (69) 

For a fixed Xp it is easy to check that the observation model in Eq. (69) is linear in ae. Therefore 
given Xp, ae can be found as the solution of a standard least squares problem [20] as 

. juix^pfwr'^ 

Then substituting Eq. (70) in Eq. (69) we obtain the expression for J^{xp, ae) 



J'{Xp,ag) 



J JuK'^p 



^'*""-'°'^ T* r ^,, . , ,, 3u{x%ywr'^ 



3u{x'pyW3u{x'p)\ 



w 



3 3u[Xpj 



ju{x'pywux%)\ 



(71) 



Exploiting the orthogonality principle of linear least squares [20], Eq. (71) reduces to 



Ti^^ A \ i^obs\t (..r W3u{x'p)3^{x'pyW \ ^fe, 

Hxp. ae) = {3 )[W- -J^^^y^WU^j ' ^''^ 

Since (^j°^^)^\Yj°''^ in Eq. (72) does not depend on Xp,it is irrelevant in the minimization. Thus 
neglecting it and considering the opposite of the remaining term, we can equivalently maximize: 

rf^s\ A /■obs\t'^Ju{Xp)ju{Xp) W i^g 

Finally, by defining c{xp) = MfLei — _^ ^^g can rewrite Eq. (73) as 

g{x'p) = ir'ycix%)cix},yr'-' (74) 

= {r'\c{x^p)f (75) 



which concludes the proof. 

Appendix E 
Choice of {fi,f„} 

In this section we will derive the expressions in Eq. (33). For the sake of simplicity we will 
use the short-hand notations rj = ri(xT,Xp) and 9i = 9i(xT,Xp). We start by considering 
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the block decomposition of J , through Eq. (63). Let us focus in particular on J [1, 1] and 



J [2,2], i.e. the diagonal blocks, whose explicit expressions are given by 



J°''^[l,l] 



A(l 



a.; 



1=1 






cos 



-V2sin(2^i 



1/2 sin (2^i) sin^ 



(76) 



— V — 



J°'^[2,2] 



n 9 

i=l « 



COS 



1/2 sin {29i 



-y2sm{29i) sin^ 



^A 



note that an analogous expression holds for J [1,2], i.e. J [1,2] = ^e XlILi 



^n ai{l-ai) 



(77) 



Di. It 



can be readily shown, through Eqs. (76) and (77), that tr (J°^'^[£, £]), 



tr(j°^"[l,l] 



tr(j°''^[2,2]) 



ae 



ae 



n 

4 = 2 

n— 1 



,1 -«i) 



1 ir J. 



i=\ ^i 



e {1,2}, are given by 
(78) 

(79) 



;i -aiY < (1 -ai+if, 



2 2 



From inspection of Eqs. (78) and (79), it is apparent that each trace is a weighted sum (scaled 
by ae) of ^. Note that, by definition, the following inequalities hold Vi G X: 

(80) 

By exploiting them, we have that in tr (J°'^^[l, I]) (resp. tr (J°^'^[2,2])) the term ^ (resp. ■\) 
receives the highest weight, while the term -^ (resp. -^) contributes to the sum with zero weight. 
To obtain a good approximation (and avoid biased estimates) of {ri, r„} we first consider convex 
combination counterparts of Eqs. (78) and (79), since the positive weights in tr (J°^'*[l, 1]) and 



tr (J°^''[2,2]) do not satisfy the normalization property (i.e. Yll=ii^ 



a,- 



^ 1 and Er=i «.' ^ 



1). The reasons are twofold: {i) the weights ai and (1 — «») appear in squared form in Eqs. (78) 
and (79); and {ii) even ai and (1 — ttj) do not sum to one^^ For such a reason we normalize 

tr (J°^^[l, 1]) (resp. tr (J°^^[l, 1])) by ^^1(1 



UiY (resp. Yll=i <^«^)- Then, we note that if 



ri, i 9 ftj ^ 1 



(6) Tj 



Tr. 



J 9 (1 - a,)' < 1 



(81) 



"For example in the case of uniform sampling it holds X]r=i "-*» ~ X]r=i(^ ^ '-'^0 ~ f > ^^^^ ^^^^ grows proportionally 
with the sample rate. The growth of X^f^i ^"^ ^"'^ X]r=i(l ^ '^») ^''■'^ '^'^^ sample rate is present also under the more general 
non-uniform sampling assumption, but in the latter case X]r=i '^^ 7^ Sr=i(l ^ '-'O 7^ f • 
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tr( J°'"'\l 1\\ trf J°'"'\2 2\\ 

the terai yX q_^,-)2 (resp. -y^ — ^^V^) well approximates ^ (resp. ^), thus leading to Eq. 
(33); therefore the value of tr (J°^*[l, 1]) (resp. tr {J"'"[2, 2])) will be high when the platform 
trajectory is near to the target at the beginning (resp. at the end) of the observation time. The 
conditions in Eq. (81) reflect the assumption that ranges at early (resp. late) time samples have 
non-negligible weights in Eq. (78) (resp. Eq. (79)) but they are very similar to ri (resp. r„), 
which is a reasonable assumption in sonar tracking. Also, note that the mentioned condition is 
weaker than r^ ^ r,\/i E I, (i.e. an approximately constant range assumption) and includes it 
as a more restrictive case. 

Appendix F 
Choice of {ii,i„} 

The purpose of this Appendix is to show that: (i) J"^^ contains only incomplete information 
about {ii,i„}, meaning that it is not possible to extract these vectors without ambiguity; {ii) a 
good approach to extract such information is represented by Eq. (37). 

For this purpose, let us consider the definition of Di in Eqs. (76) and (77). It can be readily 
shown that each D^ has eigenvalues {Ai j, A2,j} = {1,0} and that the corresponding (orthogonal) 
eigenvectors are 



e" {D,- 11 



cos [( 
— sin 



(A; 2) 



sm I 
cos 



aG{-l,l} (82) 



The pair {Ai j, e" (Dj; 1)} corresponds to the cross-range direction at tj, while {A2,j, e" [Di] 2)} 
corresponds to the range direction at tj. In fact, recall that each D^ has an informative con- 
tribution along the cross-range direction, thus Ai,j = 1^^; on the other hand each Di has no 
informative contribution along the range direction (since the range is estimated with at least two 
bearing measurements), that is A2,i = 0. For this reason the information related to ii (resp. i„) is 
contained in e" (Z?i; 2) (resp. e" (-D„; 2)). Note that however the sign-ambiguity in the definition 
of e" [Di] 2) (resp. e" (-D„; 2)) denotes the impossibility of recovering exactly ii (resp. in), even 
if Di (resp. £>„) had been perfectly available (a graphical description is given in Fig. (15)); this 
proves (i). 

'^Note that even if the informative contribution of Di is always Ai,i — 1 along the cross-range direction, its contribution in 
the FIM is weighted by \. 
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\V 








Estimated Target 



Cross-Range^ 



Platform V J^ e°(A;l) 



C 



Figure 15: Eigenvectors ambiguity in the choice of {ii,i„}. 



Before proceeding in the proof, it is worth noting that e°- {biDi]t) = e°- {Di]t), t E {1,2}, 
bi E IR+; for such a reason in the following w.l.o.g. we will search for a matrix Ki which 
approximates well Di, except for a scale factor hi, i.e. Ki ^ fej-D^; once Ki is obtained, the pairs 
{if,i^}, p,q E { — 1, 1}, are simply evaluated by considering the least informative eigenvectors 
of Ki and Kn, respectively. 

To obtain good estimates of &1-D1 and 6„-D„ we can consider 



i=2 



n— 1 9 



K„ 4 jobs^2,2] = ^Dn + aeJ2^D, (84) 

where in Eq. (83) (resp. Eq. (84)) we stress the (scaled) contribution of Di (resp. Z?„) w.r.t. 
the spurious terms, i.e. D^, i E X\{1} (resp. i E Z\{n}). Exploiting again the inequalities 
among ai and the assumptions of Eq. (81), it can be shown that ^Di (resp. ^Dn) is well 

''"1 ''^n 

approximated by Eq. (83) (resp. Eq. (84)); note that in this case convex combination counterparts 
are not needed because eigenvectors are not changed by a scaling factor. However, we will show 
hereinafter that a better estimate of biDi can be obtained. 

In fact let us consider C°^' = {j"''') -^ and denote C°'"[£,m] as the (£,m)th [2 x 2] block 
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matrix of C . By exploiting the block-wise inversion formula [5] we obtain 



(C°^"[2,2])-i 



J°^^[2, 2] - J°*^[l, 2] J°^"[l, 1]-V°^"[1, 2] 



(85) 
(86) 



Exploiting the expression for J[(i,m], i,m E {1,2} as in Eqs. (76) and (77) and putting in 
evidence the scaled contribution of Z>i (resp. -D„), we get: 



{C"'^[l, 1])-' = ^r>i + aelj2 ^^^ [(1 - "^)'^2 - «^(1 - «^)Ti] 



(^^^[2,2])-^ 



' n— 1 -. 

^ A. + «e <! 5^ -2 



A [«^'/2 - a^(l - ai)Tn] 



(87) 
(88) 



where Ti and T„ are defined respectively as 



Ti 



n 9 

.^=2 ^^ 



E^ 



-1 



£>/ 



n-l . 

i=2 



«i 



^i 



A 



-1 



ae 



n— 1 



A 






a 4 



D, 



(89) 



(90) 



=1 ^ / i=2 J 

It is apparent how each spurious term in the braces of Eqs. (87) and (88) (cf. with Eqs. (83) and 
(84)) is now filtered through the matrix gain Ti (resp. T„) with weight aj(l — aj). The matrix 
Ti (resp. T„) represents a "smoothing" factor (independent of U, cf. with Eqs. (83) and (84)). 
The weights ai{l — ai) are such that there is a higher correction w.r.t. Di corresponding to the 
the middle of the observation interval, while a little correction at the beginning or the end of the 
observation interval. However, while in the first case the correction tends to reduce the spurious 
term, in the latter case there is an increase of the error given by the spurious term. 

To gain intuition about the effect of matrix Ti (same considerations apply to T„ in Eq. 
(88)) on Eq. (87) let us consider the case r^ ^ r, \/i E I. In this case we have that Ti ^ 
(X]"=2 Oii^Diy X]^=2 '^ji^ ~ ^j)-^j ^^^ the the sum of the spurious terms in Eq. (87) reduces 
to 

- ^ A [(1 - «.)'/2 - «.(1 - «.)Ti] } (91) 



ae 



i=2 



Thus the magnitude of Ti will depend on the ratio of the concentration of tj at the middle of 
the observation interval by the concentration of U at the end of the observation interval; in fact 
a higher ratio will imply a lower distortion in the smoothing of residual terms. 
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Remark: Note that Eqs. (87) and (88) cannot be exploited to obtain better estimates of fi 
and f„ than the ones in Eq. (33), even if the spurious terms are smoothed in such a case. The 
reason is that a proper normalization factor to obtain a convex combination cannot be found, 
since it can be shown that such a value would be dependent on Dj, i E I, which are clearly not 
available. 

Appendix G 
Choice of pp{tk) 

In order to obtain pp{tk) we will first seek an approximation of pp(tj„) (denoted as pp{trn)), 
where tm — argmini^gr \\ti — *"^*^ ||^, i.e. the nearest tj to the middle of the observation interval. 
Similarly as {pp(ti),pp(tn)} (cf. Eq. (31)), we can express pp{tm) as 

Pp{tm) = PAtm) + r-mim (92) 

The estimate of r^, denoted as fm, is obtained, in analogy to Eq. (33), as 



tr(j''''^[l,2] 



tr(J°^^[l,2]) 
am(l - a 



ae 






o-iil- ai 



(93) 
(94) 



As opposed to the case of {ii,i„}, the estimate of i^, denoted as i„j, is obtained exploiting 
J°^^[l,2] as a rough estimate of bmDm, similarly as in Eqs. (83) and (84): 



e''(j"^^[l,2];2) 



J°'"[l,2] 



ae 



(XjYi\^ ^m) 






aAl - a,;l 



A 



q 3 sign{e^{j"''[l,2];l),u) = sign(i,,u), J e {-1,1} 



(95) 
(96) 

(97) 

The last line accounts for the sign ambiguity, in analogy to Eq. (39). The explicit form of 
Pp{tm) is obtained by replacing {rm,im} with {fmiim} in Eq. (92). Some important remarks, 
about pp{tm), are in the following: 

• Eq. (94) represents a weighted combination of the inverse squared ranges, in analogy to Eq. 
(33). However it is apparent that the weight corresponding to -^, that is a0am{l — am), is 
weaker in this case w.r.t. the weights of the spurious terms. This leads not only to a poorer 
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estimate f^, as opposed to fi and f„, but also f^ will be biased toward the line between tq 
and r„, leading to an estimated low-observable platform trajectory (which is not desirable 
as an initial guess); 
• In Eq. (96) J°'^'^[l, 2] is used as a bmDm estimate, since a better estimate cannot be found, 
differently from {£>!,£>„}. In fact it can be shown that (C°^'^[l, 2])^^ does not represent 
a better estimate of b„iD„i. Therefore J°^^[l,2] represents the only existing approximation 

Oi O^Yi-'-^m' 

The above considerations suggest that one select a reasonable estimate of pp{tk) according to 
a different approach, as described in the following. 

In fact, we assume that the two legs form a ±| angle, since the platform needs to perform 
a maneuver that guarantees a good degree of observability; therefore {pp(ti), jDp(tfe), jSp(t„)} 
will form a right triangle. Furthermore the sign ambiguity in the turn leads to the definition of 
two specular vectors, denoted as pe{tk), i E { — 1,1}. 

Since t^ is assumed known and s is constant during the two legs, it can be shown, after 
geometric considerations, that such vectors are given by: 

sin (ipe) 
cos {ipe) 

■4)1, = arctans (pp(t„) - pp{ti)) + i ■ ( g ~ ^) (99) 

u = arctan I | (100) 



pe{tk) = ppih) + ,^ _^. Wppitn) - pp{ti) II2 cos (z/) 



(98) 



(tk-ti) 



where v and u^'Zt) WPpi^n) — Pp(^i)||2 cos (z/) represent the angle whose vertex is pp{tn) and 
the distance between pp(ti) and pi{tk), respectively. Finally, the unit vector sin {jp^) cos {ipp) 
represents the direction from pp{ti) to pi{tk) and accounts for the sign ambiguity in the turn, 
through the angle ^^. 

The ambiguity is resolved by exploiting the coarse information given by Eqs. (94) and (96): 



t 



Pp{tk) = Pq{tm) (101) 

q = arg min ||pp(t„,) - p£(t„)||2 (102) 

where Pi{tm) denotes the position vector at tm of the two-leg trajectory described by 

{pp{ti),Pl>{tk),Pp{tn)}. 
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